/*
 * Copyright (c) 2015, Freescale Semiconductor, Inc.
 * Copyright 2016-2020 NXP
 * All rights reserved.
 *
 *
 * SPDX-License-Identifier: BSD-3-Clause
 */

#include "ffconf.h"

/* This fatfs subcomponent is disabled by default
 * To enable it, define following macro in ffconf.h */
//#ifdef RAM_DISK_ENABLE

#include "fsl_common.h"
#include "fsl_ram_disk.h"
#include "bootloader.h"
#include "fsl_debug_console.h"
#include "fsl_cache.h"
/*******************************************************************************
 * Globals
 ******************************************************************************/
static uint8_t disk_space[FSL_FF_RAMDISK_DISK_SIZE];

/*******************************************************************************
 * Code
 ******************************************************************************/
/*!
 * @brief Get RAM disk status.
 */
DSTATUS ram_disk_status(BYTE pdrv)
{
    if (pdrv != RAMDISK)
    {
        return STA_NOINIT;
    }
    return 0;
}

/*!
 * @brief Inidialize a RAM disk.
 */
DSTATUS ram_disk_initialize(BYTE pdrv)
{
    if (pdrv != RAMDISK)
    {
        return STA_NOINIT;
    }
    return 0;
}

/*!
 * @brief Read Sector(s) from RAM disk.
 */
DRESULT ram_disk_read(BYTE pdrv, BYTE* buff, LBA_t sector, UINT count)
{
    static uint8_t i = 0;
    if (pdrv != RAMDISK)
    {
        return RES_PARERR;
    }
    //lbaData->buffer = (uint8_t *)(FAT_FS_START_ADDR + lbaData->offset * LENGTH_OF_EACH_LBA);
    //buff = (BYTE* )(0x60100000 + sector*FSL_FF_RAMDISK_SECTOR_SIZE,FSL_FF_RAMDISK_SECTOR_SIZE * count);
    //PRINTF("count = %d , sector = %d\r\n",count,sector);
    memcpy(buff, disk_space + sector * FSL_FF_RAMDISK_SECTOR_SIZE,FSL_FF_RAMDISK_SECTOR_SIZE * count);
//  DCACHE_InvalidateByRange(0x60100000 + sector * FSL_FF_RAMDISK_SECTOR_SIZE, FSL_FF_RAMDISK_SECTOR_SIZE * count);
    //memcpy(buff, (uint8_t*)(0x60100000 + sector * FSL_FF_RAMDISK_SECTOR_SIZE), FSL_FF_RAMDISK_SECTOR_SIZE * count);
    //PRINTF("buff = %s\r\n",buff);
    //memcpy(buff,disk_space ,1 * count);
    //memset(buff,0x77,sizeof(FSL_FF_RAMDISK_SECTOR_SIZE*count));
    
    //memcpy(buff, disk_space + sector * FSL_FF_RAMDISK_SECTOR_SIZE, FSL_FF_RAMDISK_SECTOR_SIZE * count);
    
    return RES_OK;
}

/*!
 * @brief Write Sector(s) to RAM disk.
 */
DRESULT ram_disk_write(BYTE pdrv, const BYTE* buff, LBA_t sector, UINT count)
{
    if (pdrv != RAMDISK)
    {
        return RES_PARERR;
    }
    subsection_program_with_addr((uint8_t *)buff,FSL_FF_RAMDISK_SECTOR_SIZE * count,0x60100000+sector * FSL_FF_RAMDISK_SECTOR_SIZE);
    
    //memcpy(disk_space + sector * FSL_FF_RAMDISK_SECTOR_SIZE, buff, FSL_FF_RAMDISK_SECTOR_SIZE * count);
    memcpy(disk_space + sector * FSL_FF_RAMDISK_SECTOR_SIZE, buff, FSL_FF_RAMDISK_SECTOR_SIZE * count);
    return RES_OK;
}

/*!
 * @brief Miscellaneous RAM disk Functions.
 */
DRESULT ram_disk_ioctl(BYTE pdrv, BYTE cmd, void* buff)
{
    if (pdrv != RAMDISK)
    {
        return RES_PARERR;
    }
    switch (cmd)
    {
        case GET_SECTOR_COUNT:
            *(uint32_t *)buff = FSL_FF_RAMDISK_DISK_SIZE / FSL_FF_RAMDISK_SECTOR_SIZE;
            return RES_OK;
            break;
        case GET_SECTOR_SIZE:
            *(uint32_t *)buff = FSL_FF_RAMDISK_SECTOR_SIZE;
            return RES_OK;
            break;
        case CTRL_SYNC:
            return RES_OK;
            break;
        default:
            break;
    }
    return RES_PARERR;
}
//#endif /* RAM_DISK_ENABLE */
